#include "constants.h"
#include "library.h"

#ifndef ODOMREADING_H_
#define ODOMREADING_H_

/*** The original nav_msgs/Odometry is an overkill for out task
 * This is gives a much simplified and visible interface
 */
class OdomReading {
public:
	double x,y,theta;
	OdomReading(nav_msgs::Odometry msg);
	OdomReading(double x,double y,double theta);

	double calculateDistanceTo(OdomReading &current);
	double calculateRotation(OdomReading &current);

	virtual ~OdomReading();
};

#endif /* ODOMREADING_H_ */
